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SUMMARY 


This  report  presents  methods  for  transfer  alignment  (TA)  of  inertial  navigation  systems  (INS) 
which  have  been  published  in  the  accessible  literature  during  the  last  three  decades.  Kalman 
filtering  techniques  based  on  linearised  dynamics  dominated  in  the  literature  of  the  subject. 
Methods  ofTA  can  be  classified  as  angular  rates,  velocity  or  position  matching.  In  each  case 
a  number  of  assumptions  are  made  to  ensure  the  validity  of  proposed  teclmique.  The 
accuracy  of  filters  depends  on  the  particular  implementation  viz.  allowable  manoeuvres  and 
time  ofTA,  microprocessor  used,  vibration  environment,  inclusion  of  wing  flexure  into  the 
model,  type  of  application  under  discussion  (range  of  missile  or  time  of  flight),  quality  of 
output  from  inertial  measurement  units,  etc.  Authors  briefly  discuss  methods  of  in-flight 
transfer  alignment  of  INS  taking  into  account  these  assumptions. 
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1.  INTRODUCTION 

The  process  of  aligning  an  inertial  navigation  system  (INS)  using  the  data  supplied  by  another 
INS  is  called  in  the  literature  a  transfer  alignment.  More  strictly  transfer  alignment  is  defined  as  a 
process  of  estimating  the  relative  angular  difference  between  positions  of  two  (or  more)  coordinate 
systems  by  measuring  the  position  of  each  of  the  systems  with  respect  to  the  two  or  more  vectors 
common  to  all  coordinate  systems  (see  [1])  for  the  purpose  of  updating  and  calibration  of  guidance 
instruments. 


In-flight  transfer  alignment  (TA)  is  applicable  in  the  following  circumstances  : 

( 1 )  correction  of  aircraft’s  inertial  navigation  system  (INS)  using  external  data  (output  of  additional 
sensors,  set  of  terrain  reference  points,  or  coupling  with  GPS  receiver,  that  is,  the  case  of  aided 
INS), 

(2)  initialisation  and  calibration  of  a  weapon’s  inertial  measurement  unit  (IMU)  using  the  data 
from  the  carrier’s  (aircraft  or  ship)  guidance  instruments,  with  additional  assumptions  on  accuracy 
of  the  carrier’s  navigation  instruments. 


We  could  also  envisage,  as  a  separate  case,  correction  of  data  from  the  weapon's  gyros  during 
the  independent  flight  (after  the  separation  from  the  carrier)  using  additional  instruments  (mag¬ 
netometers,  GPS  receiver,  Doppler  radar),  but  as  far  as  the  methods  are  concerned  it  coincides 
with  (1)  and  only  the  accuracy  requirements  for  tactical  applications  may  differ.  Some  authors 
have  reported  (cf.  (2).  [3])  on  more  recent  and  current  research  work  aimed  at  finding  an  efficient 
solution  to  tiiis  problem.  A  brief  review  of  literature  on  transfer  alignment  is  given  by  Barlow  [4]. 

1‘sually  the  more  complex  system  of  aircraft's  inertial  instruments  is  referred  to  in  the  literature  as 
a  "master”  INS.  while  the  set  of  (usually  strapdown)  inertial  sensors  on  a  missile  is  called  a  "slave” 
IMC. 


lu  this  report  we  will  concentrate  on  methods  of  aligning  an  unaided  set  of  inertial  sensors  with 
emphasis  on  low-cost  strapdown  guidance  instruments  applicable  to  gliding  stand-off  munitions. 


Ail  methods  of  TA  described  in  the  accessible  literature  are  based  on  particular  vector  matching 
techniques  (dependent  on  physical  justification)  and  almost  all  use  an  algorithm  for  state  identifi¬ 
cation  of  stochastic  systems  known  as  a  Kalman  filter  (KK).  The  filter  may  be  characterised  as  a 
minimum  variance  estimator  and  its  implementation  is  based  on  art  assumption  that  probabilistic 
descriptions  of  errtm.  are  available  on-line  during  the  estimation.  Other  techniques  worth  men¬ 
tioning  am  tSie  maximum  likelihood  method  and  stochastic  or  deterministic  differential  games.  It 
seems  >  h:.t  deterministic  adaptive  model  following  (often  referred  to  as  Mil  AG  ■  a  model  reference 
adaptive  control)  with  uncertainty  parameters  belonging  to  some  compact  set  (no  specification  of 
stochastic  behaviour  of  the  noise  is  necessary  in  this  case)  may  also  be  useful  for  our  application. 
In  this  review  we  concentrate  only  on  the  "mainstream  approach”.  Alternative  methods  applicable 
for  such  a  particular  identification  problem  as  TA  are  briefly  mentioned  at  the  end  of  this  report. 

Prior  to  the  description  of  methods  for  TA  we  briefly  present  basic  formulae  used  for  the  estimation 
problem  {words  :  filtering,  estimation,  identification  are  used  here  interchangeably)  by  Kalman 
filters 
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2.  THE  DESIGN  OF  A  KALMAN  FILTER 


2.1  Linear  estimation 

In  the  general  case  the  equations  for  a  linear  discrete  Kalman  filter  are  as  follows.  The  system 
model  is  represented  by  N  stochastic  linear  difference  equations  for  the  state  vector  i*: 

•L'k  =  +  I'tiUfc-!  +  ^(0 ,Qk)  (1) 

where  d>  is  an  N  x  N  nonsingular  transition  matrix,  Ift  is  an  N  x  r  input  matrix  with  con¬ 
stant  entries,  Uk  is  an  r-dimensional,  deterministic  (perfectly  known)  input  (control),  x 9*  is  an 
uncorrelated  white  noise,  referred  to  as  a  process  noise,  while  F  (n  xq  constant  diagonal  matrix) 
determines  the  strength  of  the  noise.  In  most  of  the  discussed  TA  .algorithms  the  term  referring 
to  deterministic  input  is  ignored.  Including  it  causes  a  minor  change  in  the  state  propagation 
equation  (formulae  (5)-(5a)). 

The  measurement  model  is  designed  as  a  set  of  M  equations 

*k  =  Hlc*k  +  £>j k  9k  **  .V(0,  Ilk)  (2) 

with  H  being  an  M  x  S  matrix  and  pj.  the  white  noise,  referred  to  as  a  measurement  noise. 

Initial  conditions  are  assumed  to  be  known 

4*(0)]  =  -fo.  £[(-r(0)  -  zo)(x(0)  -  -r0)T]  =  ft  (3) 

where  ft  is  the  initial  covariance  matrix  giving  a  statistical  measure  of  confidence  that  the  states 
are  error- free. 

Other  assumption;,  are  concerned  with  the  correlation  of  the  noise 

Ajdfcpf ]  =  0,  for  k  -  1,2 . A  and  j  s  1,2,  ...  St 

to*,  fw  >.*=1.2 . M  (4) 

Aldtdfj  Q^kj  for  k-.j  =  1.2 . -V 

where  >'kj  denote>  Kroueeker  delta  function. 

The  stale  estimates  are  then  extrapolated 

(5) 

to  obtain  the  components  ot  the  state- vector  at  the  beginning  of  the  k-lh  interval  using  the 
values  obtained  at  the  end  of  the  (k- 1  )-th  interval.  With  the  deterministic  input  present  in  the 
system  model  we  would  have 


•ft  =  +  I 

Error  covariance  extrapolation  is  calculated  via  the  matrix  equation 

/v  =  +rQ*-,r 


(5») 


(6) 
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Mathematical  model  Measurement*  Diicme  Kalman  filter 

(discrete  linear  system) 


Figure  1  General  Filter  Configuration 


The  Kalman  gain  matrix  may  now  be  calculated  as  : 

Kk  =  P:Hl[Hkp-Hrk  +  Rk]~l  (7) 

which  in  turn  is  used  to  update  the  state  estimates 

*t  =  *k  +  -  Hki~k]  (8) 


and  the  error  covariance  matrix 


p;  =  (/  -  KkHk\p;  -  (/  -  Kknk\pk-[I  -  Kknk}r  *•  KknkK[  (9) 

The  whole  process  may  he  easily  represented  by  the  block-diagram  shown  in  figure  1. 

The  above  formulae  are  valid  only  if  the  specific  assumptions  (on  the  linearity  of  the  process, 
white,  uncorrelated  noise  and  on  initial  condition*  are  fulfilled,  in  particular  one  must  remember 
that  the  assumption  on  stochastic  controllability  and  observability  is  also  applied  to  (1)*(2), 
whbh  means  that  (cf.  (5)  for  formal  definitions) 


>  t 

j  =  < - v+i 

for  stochastic  observability 

.  for  complete  stochastic  controllability 


{ 10) 


where  0  <  o  <  J  <  oc.  When  the  above  assumptions  arc  satisfied  the  filter  is  uuiformly 
asymptotically  stable  (cf.  (5j).  In  the  case  when  the  system  and/or  measurement  model  are 
nonlinear  •  i.e.  equations  { 1  }•  (2)  are  replaced  by  ( 11  )•{  12)  •  and  either  the  linearised  or  extended 
Kalman  Killer  are  used. 
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2.2  Linearised  KF 


The  system  is  modelled  now  by  a  system  of  stochastic  nonlinear  differential  equation,  in  partic¬ 
ular  for  a  continuous  case 

i>  =  /i[x(/),u(l),  t]  +  Gii9,(t)  ,  (li) 

with  $;(')  a  white  noise,  is  1,2,...  ,  N ,  where  N  is  the  dimension  of  the  process,  Gi  defines  the 
strength  of  the  noise  and  f(-)  fulfilling  standard  assumptions,  so  it  is  lipschitzian  with  respect 
to  i;  and  continuous  w.r.t.  control  variables.  Both  f(-)  and  u(f)  are  assumed  to  be  piecewise 
continuous  w.r.t.  time.  The  measurements  taken  at  time  intervals  (<*,<*+1)  are  modelled  by 
the  nonlinear  function 

z(4)  =  h[x(fjt  ),**]+  g(tk)  (12) 

where  g(  •)  is  defined  in  the  same  way  as  for  the  linear  filter.  It  is  further  assumed  that  a  nominal 
(reference)  state  trajectory  xrfj  can  be  generated  in  such  a  way  that  it  satisfies  the  deterministic 
ordinary  differential  equation  : 

x„/(<)  =  f[x„/(/),u(f).f]  (13) 

It  is  assumed  that  the  deviations  from  the  reference  trajectory  are  small  enough  to  justify  the 
use  of  linear  perturbation  technique.  In  order  to  satisfy  this  requirement  the  same  control 
variables  are  used  in  nominal  and  real  models.  Denoting 

fix  =  x  -  xTej  and  consequently 
fix  =  x  -  xrc/(/) 

the  process  fix  satisfies  the  nonlinear  stochastic  differential  equation 

*x  =  /[x.u./j  -  /[xr,/,ujj  +  G( /)!>(/) 


(1-1) 

( 15) 


Expanding  the  KHS  of  the  above  equation  as  a  Taylor  series  we  have 

rll.O.T.+G(l)i>(l)  ( 10) 

X  =  K../lO 

/.'"ter  discarding  higher  order  terms  the  original  nonlinear  equation  has  its  first  order  approxi¬ 
mation  : 

.'x  =  F[x„/(M.ll*x(f)  +  G(f)d(0  (17) 

where  Ff -I  is  an  by  n  matrix  with  entries  being  partial  derivatives  of  /(•)  evaluated  along  the 
reference  trajectory  and  G(0  is  a  diagonal  matrix  with  entries  f*,(f).  Similarly  the  perturbation 
measurement  model  of  discrete  observation  is  obtained 


t>f[x.ui  l)./J  I 
- - - 

Ox 


*»(/*)  «  H(x„/(i*)./.J*xt#i)  +  tKffc) 


(1»? 


where  H  is  defined  : 


H  * 


09) 


Converting  equation  (17)  to  discrete  form  and  applying  the  previously  defined  linear  filter 

(equations  (7)  and  (Sj)  we  obtain  an  optimal  estimate  of  flx(f)  denoted  by  fix{t).  Then  the  bee* 
estimate  of  the  total  stale  i* 

xt  #  * )  =  X„/  +  *x(f*)  (20) 

The  procedure  ending  in  the  above  estimate  is  called  a  Unearned  Kalman  filter.  The  assumption 
of  small  deviation  from  the  reference  trajectory  is  certainly  th*»  most  limiting  one  and  the  next 
approach  tries  to  overcome  this  shortcoming  of  the  linearised  filter. 
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2.3  Extended  KF 


For  the  extended  KF  the  process  of  linearisation  of  state  and  measurement  systems  is  repeated 
after  each  evaluation  of  x,  with  the  initial  condition  defined  as  the  recent  update  of  the  state. 

As  a  result  the  formulae  for  gains,  state  estimate  and  covariance  matrix  of  the  extended  filter 
may  be  expressed  in  the  following  way.  The  solution  to  the  reference  (nominal)  equation  with 
the  initial  condition  x(<£)  is  denoted  xrt/(//4.).  Then 

K(*fc)  =  P(^)H3K.x(i;)HH[/*.x(/t)]P(<pHT[t*,x(/i  )]  +  R(4)}-‘ 

x(f£)  =  x(/p  +  *x(<+)  =  x(/;)  +  K(tk){zk  -  h(x(/; )./*]}  (21) 

Pitt)  =  P(*;)-  K(4)H[4,y(/;)]P(/;) 

The  estimate  is  propagated  from  4  to  4+1  via  integration  of  nominal  differential  equations  with 
Xref  replaced  by  x.  Matrices  F  and  H  are  defined  in  a  similar  way  as  for  the  linearised  filter 
except  that  the  entries  are  now  evaluated  at  each  x(f^ ).  Estimation  of  the  covariance  matrix 
explicitly  depends  on  the  estimate  of  the  state  variables. 


2.4  Reducing  the  order  of  Kalman  filter 


We  could  deal  here  with  two  possible  cases  :  either  we  design  a  system  and  observation  model 
having  a  minimal  number  of  variables  and  then  use  the  standard  algorithms  described  in  2.1- 
'*  ’*  <’r  if  'he  <»n  a  sghvt  of  variables  of  an  existing  mode!  ceases  to  be  important, 

or  for  some  reason  is  unavailable,  such  variables  may  be  excluded  fr<»rn  further  processing, 
1  he  reduction  by  design  depends  on  the  physical  relationship  between  variables,  i.e.  choice  of 
particular  equations  for  observation  and  system  models.  Examples  of  such  filters  applied  to  the 
transfer  alignment  problem  are  presented  in  3.1.  An  exclusion  of  information  on  some  subset  of 
variables  from  further  processing  is  called  a  reduced  order  KF.  There  is  a  number  of  subopttmal 
and  optimal  techniques  dealing  with  the  reduced  order  KF  as  discussed  in  [5)  and  (6). 


One  set  of  possible  algorithms  for  optima!  reduced  order  filtering  is  given  by  Simon  and  Stub- 
herud  [6|.  The  theoretical  derivation  is  illustrated  by  an  example  of  a  hypothetical  satellite 
carrying  a  strapped-down  IMF  and  two  star-track**rs.  Information  from  the  star  tracker  is  used 
to  calibrate  the  IMF's  gyro  biases,  scale  factors  and  misalignments. 


Ibis  particular  technique  t*  formulated  in  the  fallowing  wav.  The  system  model  is  assumed  to 
consist  of  two  blocks 


s i4)  a  t  d 

0*4)  —  A* Jr*  *  Fi-o*  St 


122) 

(23) 


while  the  observation  model  may  be  presented  as 


-*  -  //***  +  4*0*  +  Qk 


(24) 
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where  the  vectors  o  and  s  are  p- dimensional.  ;  and  o  are  m-dimensional,  and  the  system  and 
observation  matrices  are  of  appropriate  dimensions.  Furthermore  the  standard  assumptions  for 
d,  3  and  n  apply,  that  is  they  are  uncorrelated  white  noise  processes,  with  respective  covariances 
denoted  by  Ilk,  and  The  initial  conditions  for  the  system  model  are  the  gaussian  random 
variables  with  known  means,  say  xq.  fto.  and  covariances  A'o  and  Do-  Simon  and  Stubberud 
assume  that  (L^Lk)  has  an  inverse  and  x*  is  independent  of  ak. 

The  estimates  ak  of  ak  are  not  required  in  the  process  so  the  system  may  be  reduced  from  (n+p) 
to  ( n).  Instead  of  the  output  ;k  the  authors  introduce  the  difference  operator 


Uk- (-1  —  -A-+1  l>k+\  Ekl'k~k  (do) 

where  /,J  is  a  one-sided  pseudo- inverse  with  assumption  that  it  coincides  with  L kl  if  the  latter 
exists  or 

L\  -  il'I Lk)~l  !-l  (26) 

The  existence  of  Lk  requires  p  <  rn  and  that  rank  Lk= p.  The  new  difference  operator  replaces 
the  original  observation  model,  so  now 

i/A+t  =  A/aX*  4-  trt+1  (27) 

with 

Mk  =  llk+\$k  f  /- a  +  i  +  /-a+i-Ia  -  Lk+iEkLlH k  (2*) 

U'k-fl  =  +■  l'k  +  l  Ak  4-  £>fc+l  -  /-»>+>£«££«  A  (29) 


However  the  measurement  noise  is  now  coloured,  so  the  standard  assumptions  of  the  basic 
Kalman  filter  no  longer  apply.  The  noise  is  correlated  over  one  step  with  the  covariance  matrices 
specified  as 


,r«»ttt‘Li!  =  Ib+i  -  Wa+i  H* II i  4  I  a-  4-  /-ts,! 

SkllVtLll!  Ll.%  im 

^  |y‘e^  I  i  s  ^  ktl.i  =  1  t-ic  L  ^  \  4- 

(31) 

A’[u-i4/u'fj  =  0  for  |  ^  | 

(32) 

I  i U'u u0  j  2  lo  4  /-o  --pf-o 

(33! 

(34  i 

/.  i U'i  »  1  4 

(35> 

fdd.dfl  s  /.V,* 

(3bt 

finally  the  reduced  order  model  can  be  presented  as  : 


**♦»"“♦**•*  +  *>  (37  » 

y*«,  -■  A/*x 4  *  u-i4,  (3K! 

Pa  «  //oXu  +  U’a  (39) 

wttb  tb**  mittal  conditions  and  rm-ariat»c**s  specified  as  above,  thr  authors  then  obtained  the 
minimum  variance,  unbiased  estimate  of  x*  uased  on  measurement  y4.  which  is  generated 
sequentially  via  the  following  equations  : 


-H  as,  */V*r*r«/  -4  Ui4i 

rt4)  =  If/  -  >  +Ql 

«  ¥*st  -  i/k*\fk  -  y*st  -  3IaX4  -  HV4i4/'“!  Ay* 


(40) 

(41) 

(42) 
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where  yh+i/k-  *s  defined  as  the  best  estimate  of  tjk+i  based  on  jjk- 


*k+l  <^crfc  "f  C  Jt+1  ^4+l’^Ski'l 

Jk+ 1  =  +  nk  -  cMp;lxcl+x 

where  J^+i  is  the  estimate  error  covariance. 


(43) 

(44) 


A  different  approach  for  model  reduction  is  presented  by  Kortum  in  [?j.  The  method  deals 
with  the  model  reduction  in  the  case  when  the  system  noise  is  either  white  or  coloured,  while 
the  measurement  noise  has  the  classical  white  noise  characteristics.  In  the  case  when  the  mea¬ 
surement  noise  is  also  coloured  we  may  apply  the  Simon-Stubberud  method.  The  procedure 
relies  on  splitting  the  n-dimensional  state  vector  x  into  portions,  say  xj  and  i;,  of  order  n i .  »»  i 
respectively,  so  rq  +  n_<  =  n  and  jx]  =  [xj,  x2].  The  initial  set  of  system  equations  may  now  be 
written  as 


ij  =  4>n  X)  +  Oijx.>  (45) 

i>  =  /(x x»,  u.  v)  (46) 

where  u  is  an  input  (control)  parameter,  and  d  an  uncorrelated  noise  with  power  spectral  density 
Q  l  he  measurement  equations  have  to  be  designed  in  the  form  : 


-i  =  //|Xi  -  pi  (47) 

=  //jX;  t-  l>;  (4- HI 

It  is  further  assumed  that  measurements  Z;  are  fairly  accurate  in  order  to  provide  good  infor¬ 
mation  on  x..  that  the  matrix  //<  is  notisingular  and  that  pi  and  p;  are  white  noise  processes 
with  the  *p*w  ified  power  sped  ral  densities 

In  terms  of  modelling  navigational  system*.  Kortum  suggests  that  equation  (46)  may  represent 
a  nonlinear,  coupled  dynamic  equation  ot  motion,  while  (45)  represents  the  set  of  linearised 
kinematic  relation*  including  the  angles  and  angular  velocity  components  It  then  follows  from 
the  assumption*  on  the  observation  model  that  accurate  knowledge  of  ail  dynamic  stats1  compo¬ 
nent*  is  required  I  he  valuer  can  be  direct Jv  obtained  from  (4*)  and  then  substituted  into  (45) 
to  V|t>|d 

Xl  “  $ltX|  *  (49) 

In  view  of  t  -{SI  •;  can  now  be  interpreted  a*  known  input  {control)  parameter.  and  becomes 

the  process  n<w o’ .  which  iii  turn  may  now  be  assumed  to  be  coloured.  In  this  case  the  state 
equations  should  be  augmented  to  include 

tri  *  n7p j  *  d  ($0) 

where  i)  is  white  muse  In  the  case  when  t»,  become*  coloured  noise,  other  special  algorithms 
should  be  applied  (cf.  May  beck  (5jj. 


s 


2.5  Compression  of  data 


The  problem  of  data  averaging  for  TA  has  been  considered  by  Powell  and  Bryson  [x],  and  Bar 
Shalom  (9].  The  idea  is  to  preprocess  the  measurement  data  between  successive  updates  of  the 
Kalman  filter.  The  filter's  processing  time  is  usually  longer  (especially  in  the  case  of  full  order 
estimation  of  gyro  drifts,  accelerometer  biases,  position,  velocity  and  attitude  errors)  than  the 
nM’a'"rf,ment  interval.  The  compressed  data  would  be  otherwise  excluded  from  the  algorithm. 
1  he  main  motive  for  averaging  is  "to  slow  the  filter  update  late  to  save  computation  time”  [8}. 
The  technique  is  a  trade-off  between  the  total  loss  of  information  due  to  its  exclusion  and  loss 
due  to  the  averaging. 

Loss  of  information  should  he  kept  low  to  minimise  estimation  error,  t  herefore  the  Bry? 
Powell  technique  is  applicable  if  : 


1 )  entries  of  system  and  observation  matrices  (d>  and  //  )  vary  slowly 


2)  the  process  noise  U  weak  by  comparison  to  the  measurement  noise 


:i)  a  priori  slate  inhumation  outweighs  the  new  information  iu  measurement  batch. 


1  he  investigations  in  indicated  that,  for  tin*  particular  problem  considered,  up  to  2’i  observa¬ 
tions  could  b«‘  averaged  with  considerable  computational  savings  and  the  most  important  factor 
behind  the  decision  on  the  number  of  observations  that  could  be  averaged  is  the  process. to 
measurement  noise  rat io 


2.4i  Parallel  processing  of  information 


Another  method  of  accommodating  the  computational  requirement  associated  with  often  non  Sin 
ear  and  high  dimensional  sy  stem*  i*  to  decent rali re  K1  algorithm  and  allow  parallel  processing  of 
information  (Gardner  tlOj  discussed  an.  algorithm  which  processes  outputs  of  Doppler  radar  and 
an  inctiai  measursnent  system  in  older  to  estimate  the  misalignment  of  soawtrs.  The  method, 
<aiied  gain  transfer  algorithm,  assume*.  processing  information  at  local  nodes  (associated  with 
the  H-am'vi  and  then  sending  the  estimate-,  to  central  pr»*ces.toy  which  obtain*  global  estimates 
based  of.  full  system  mode*  Another  method  i*  proposed  by  l{ ao  and  Durratl- Whyte  The 

fully  decentralized  algorithm  totally  eliminates  the  need  for  .'he  hierarchical  data  processing. 
1  oc al  nodes  form  a  communication  network,  sending  their  estimates  to  every  other  male  and 
estimating  w*me*  of  the  states  of  gioba)  model.  Advantage*  of  such  an  approach  are  presented  sa 

;u; 
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3.  IN-FLIGHT  TRANSFER  ALIGNMENT  ALGORITHMS 


3.1  General  assumptions 


Full-order  (all  states)  estimation  algorithms  give  on-line  information  on  sensor  errors  i.e.  pro¬ 
vide  current  knowledge  on  either  constant  or  dynamic  misalignment  (attitude  and  heading 
compared  with  the  carrier’s  INS  or  difference  in  Euler  angles  referred  to  the  aircraft’s  axes)  com¬ 
bined  with  the  velocity  errors  and  errors  resulting  from  gyro  drift  rates  and  accelerometer  biases. 
Assumption  of  constant  misalignment  angles  excludes  the  effects  of  vibrations  and  flexibility  and 
a  KF  based  on  this  assumption  may  not  be  suitable  for  realistic  application.  However,  for  the 
sake  of  clarity,  the  presentation  of  transfer  alignment  methods  starts  from  the  simplest  case 
based  on  rate  matching,  which  in  turn  is  augmented  to  more  complicated  cases.  For  full  order 
modelling  of  an  advanced  Inertial  Navigation  System  (as  on  the  carrier  aircraft)  the  following 
variables  could  be  included  : 

-  components  of  position  error  r  —  (r/v,  te,  t'd]  i.e  with  respect  to  North,  East  and  vertical 
axes, 

-  components  of  static  (constant)  misalignment  vector  7  =  [7*,  7 7^],  or  7  =  [7#,  7 £,  723] 
depending  on  the  reference  axes, 

-  components  of  dynamic  misalignment  due  to  structural  flexure  (low-frequency  elastic  defor¬ 
mations)  and  vibrations  (high  frequency  motions)  77(f)  =  [rjx(t),  VY{t),  7?z(0],  so  the  total 
misalignment  angle  will  be  denoted  by  q  where 

C  =  7+  q(t) 


-  vectors  of  angular  rates  of  both  "master”  and  ’’slave”  guidance  instruments  (in  case  of  angular 
rate  matching)  u>„,  =  [/>,</,  r]  and  \js  =  [p3,q3,rs],  and  respective  skew-symmetric  matrices  of 
angular  rates  denoted  by  pr„],  [ws], 

-  components  of  velocity  vectors  (when  appropriate)  denoted  by  v  and  v,  for  master  INS  and 
slave  IMU  respectively,  or  errors  in  North,  East  and  down  velocity  components  denoted  by 
Ai>  =  [Ai’/v,  At’£,  Aw£)] 

-  ■omponents  of  specific  force  denoted  by  /  =  [/. y.  /y,  Jz]  or  [/*.  /$,  Jo]  depending  on  the 
reference  axes,  together  with  their  coi responding  skew-symmetric  matrix  denoted  by  [f], 

-  vector  :*ci  skew-symmetric  matrix  of  linear  acceleration  denoted  by  a  =  (ar,  a„,  uT]  atid  [a] 
respectively. 

•  gyro  drifts  and  acceleration  biases  (notation  c.  V  respectively  witii  the  components  expressed 
in  some  chosen  reference  frame), 

-  gravity  deflection  and  anomaly, 

-  altimete-  output  and  bias, 

-  longitude  and  latitude  angles  denoted  by  A  and  /,,  with  6 A  and  iL  referring  to  the  errors  in 
respective  quantities  and  sL,  cL  denoting  sine  and  cosine  of  the  angle  . 
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-  earth’s  radius  and  its  angular  rate  denoted  by  R  and  11  respectively. 

The  above  notation  tries  to  follow  that  of  the  siandard  textbooks  (cf.  Britting  [12]).  However, 
in  some  instances  different  symbols  were  introduced  in  order  to  unify  the  approach. 


Stand-off  gliding  munitions  usually  require  only  very  rudimentary  navigation  and  control  sys¬ 
tems.  In  many  instances  the  guidance  system  is  reduced  to  either  a  set  of  gyros  or  to  a  relatively 
inexpensive  AHRS  (there  is  also  an  option  of  an  aided  navigation  system,  but  it  is  outside  the 
scope  of  this  report).  However,  when  the  seeker  is  not  locked  onto  the  target  before  weapon’s 
release,  i.e.  when  the  missile  trajectory  can  be  partitioned  into  the  mid-course  and  terminal 
stages,  the  initialisation  error  together  with  the  drifts  and  biases  may  cause  the  weapon  to 
deviate  from  the  planned  path,  which  in  turn  may  cause  its  failure  to  acquire  the  target. 

Control  of  the  roll  and  pitch  angie  in  the  mid-course  guidance  stage,  together  with  bank  to  turn 
manoeuvres  in  the  terminal  phase  introduces  the  requirement  for  relatively  accurate  information 
about  rates,  angles  (attitude  control)  and  accelerations  to  be  supplied  to  the  autopilot.  Therefore 
only  a  subset  of  the  listed  set  of  variables  need  to  be  used  in  the  KF  models  designed  for  aligning 
the  weapon's  AHRS  prior  to  its  mission.  A  minimum  set  of  variables  should  include  the  attitude 
and  azimuth  misalignment  and  some  modelling  of  flexural  motion.  Additionally  one  can  also 
include  models  for  gyro  drifts  and  accelerometer  biases,  but  such  an  inclusion  depends  on  time 
allowed  for  the  TA. 


In  our  analysis  we  shall  make  the  following  standard  assumptions  : 

1 )  no  equipment  failure. 

2)  compatibility  between  TA  and  other  functions  sharing  the  same  microprocessor, 

3)  master  INS  drift  free,  slave  INS  driven  by  relative  error. 

•1}  rigid  or  flexible  structure  of  aircraft  (different  design  of  filter  results  from  a  particular  as¬ 
sumption  ), 

a)  data- latency  problem  solved  (synchronisation  of  the  outputs  from  IMU  with  the  output  from 
the  aircraft ). 

(>)  exact  collocation  between  seekers  reference  axis  and  INS  coordinates  (i.e.  coincidence  of 
coordinate  axis  direction ). 

The  last  assumption  is  not  strictly  required  for  the  following  analysis,  but  we  include  it  in  the 
above  list  to  signal  the  possible  problem  associated  with  the  terminal  phase  of  guidance  on  some 
classes  of  weapons. 

After  rough  initialisation  of  the  missile's  I  Ml'  there  is  a  choice  of  three  fundamental  procedures 
(or  rather  sets  of  procedures)  for  the  transfer  alignment,  namely  position  matching,  angular  rate 
matching  and  velocity  matching.  These  procedures  may  be  considered  with  respect  to  either  a 
rigid  or  a  flexible  structure,  with  or  without  modelling  of  drifts  and  biases,  and  applying  any  of 
the  presented  filtering  techniques.  The  basics  of  the  procedures  for  TA  are  discussed  in  3.2-3.S. 

An  unaided  attitude  and  heading  reference  system  could  be  also  "roughly*  initialised  by  using 
the  attitude  (angles  only)  data  supplied  by  the  aircraft  INS.  This  however  is  not  a  case  for 
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"transfer  alignment”  (as  position,  velocity  or  angular  rates  errors  are  not  estimated),  but  what 
could  be  called  an  attitude  alignment  with  ”coarse”  initialisation  via  a  statistical  averaging 
procedure.  For  the  proper  transfer  alignment  the  required  structure  of  information  is  discussed 
in  the  following  paragraphs. 


3.2  Angular  rate  matching 


Angular  rate  matching  is  a  conceptually  simple,  but  relatively  inaccurate  method  for  estimat¬ 
ing  the  angular  errors  between  two  coordinate  systems  by  using  a  suitable  phvsical  relationship 
between  their  angular  rates  and  the  misalignment.  The  procedure  for  estimation  of  the  mis¬ 
alignment  follows  that  described  by  Schneider  [13].  The  usage  of  the  classical  Kalman  filter  is 
justified  by  a  formulation  which  relates  linearly  the  misalignment  angles  to  the  difference  i*i 
the  angular  veW;‘y  of  master  and  slave  gyros  (it  is  based  on  an  orthogonality  assumption  which 
in  turn  relies  on  frequent  updates  of  data  from  the  aircraft). 


The  measurement  vector  is  formed  from  the  differences  between  the  master  and  slave  INS’s  rates 
so  using  the  previously  introduced  notation  we  have  • 


A  p 

p-p. 

Ac/ 

Ar 

Ar 

.r~r». 

(51) 


The  state  vector  xk  is  the  unknown  (estimated)  misalignment  angle  between  the  two  reference 
frames  (denoted  by  ■))  : 


Xk  = 

Cl 

•f  2 

=  1  = 

IX 

1Y 

_ 

’  A<t>‘ 

A  0 

,C3. 

k 

.'// . 

A 

A*. 

It  is  assumed  that  the  aircraft  structure  is  rigid,  i.e.  we  deal  with  the  case  of  constant  mis¬ 
alignment  (see  lug.  *2).  Then  <!>*._  t  =  /3,  VT  €  <Y.  The  system  model  is  therefore 


xt  =  -re- 1  +  t4_i  (53) 

where  is  modelled  by  the  Gaussian  white  noise  of  variance  Qk .  Normally  for  implementation 
purposes  0  would  represent  a  white  noise  with  spectral  density  taken  as 

Qt  —  f  j  A  /  i  /i  (54) 

where  AG  =  /*  -  f*_i  and  a  a  suitable  constant  to  introduce  the  noise.  The  choice  of  a  is  a 
real  problem,  since  it  determines  the  speed  of  convergence  via  covariance  matrix  updates. 


Tudor  the  suitable  assumptions  that  outputs  of  gyros  in  both  INS’s  are  known  and  synchronised 
and  At  is  small  enough  so  the  angular  velocity  vector  does  not  change  direction  (at  it  as 
compared  to  it~\ )  "appreciably  \  the  following  algorithm  can  be  derived. 
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In  angular  rate  matching  the  observation  (measurement)  equation  is  based  on  the  following 
Kinematic  relationship  (see  Schneider  op.  cit.)  : 

(55) 

where  the  second  term  of  the  cross  product  refers  to  the  aircraft’s  p,q,  and  r.  After  some 
algebraic  manipulations  it  reduces  to  : 

0  r  -q  Q\ 

Zk  =  -r  0  p  xk+  Qi  (56) 

.  9  -p  0J*  UL 

Thus  the  observation  matrix  Hk  is  now  being  defined  as 

0  t  -q 

Hk  =  -r  0  p  (57) 

q  -p  0 

Full  formulation  of  the  filter  would  also  incorporate  the  white  noise  Qk  characterised  by  spectral 
density  Rk ■  This  is  introduced  by  Schneider  as  a  diagonal  matrix  with  entries  defined  as  twice 
the  variances  of  the  measurement  error  in  each  gyro  output  denoted  a\. 

In  the  explicit  form  we  have  the  following  set  of  equations  for  the  KF.  Since  the  $k  becomes 
the  'dentity  matrix,  the  state  equations  assume  the  form 


with  0k  the  white  noise  witn  previously  defined  spectra!  density  Qk.  The  measurement  model 
i with  the  differences  of  angular  r„tes,  i.e.  differences  between  outputs  of  gyros,  being  the 
measurable  quantities)  is  now 

Sp  Or  -r/1  So  Pl 

=  Sq  =  -r  0  p  SO  +  p-i  (50) 

Ar\k  (>  -p  0JtLAt’Jt  UJ * 

where  p;.  has  the  spectral  density  defined  as  Rk  =  ( /a  is  3  x  3  identity  matrix). 


The  Kidman  filter  is  implementiHi  as  follows  With  ,  /,0+  wel'  defined  initial  conditions,  the 
state  estimates  and  the  covariance  matrix  can  now  be  evtiapolated 

So]"  \SoV 

SO  =  SO  (60) 

if  t-i 


/V  *  *'Z-i  +  C-t  =  K  .  +•  n^4-i/a  (61) 

and  subsequently.  Kalman  gains  matrix  may  now  be  calcu’  »leo 

A*  = 

0  -r  ,  1  f  r  0  r  -q  0  -r  ]  2  Iff*  0  0  ]  * 

P-  r  0  -p  {  -r  0  p  P~  r  0  -p )  +  0  2<r*,  0  J 

P  0J*ll?  ~P  H*  l“V  P  0  J*  0  J 


(62) 
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Figure  2  Misalignment  for  rigid  structure. 

The  matrix  A't  is  now  used  to  obtain  the  updates  of  state  estimates  ( )  and  covariance  matrix 
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fa  -  A  if 

— r 

0 

P 

.  </ 

-v 

0 

k- 

which  are  the  starting  values  for  the  new  cycle  of  computations. 


(63) 

(64) 


3.2.1  Inclusion  of  flexibility  unci  vibrations  into  the  algorithm 


Augmenting  Schneider’s  algorithm  presented  in  section  3.2  as  it  was  originally  derived  in 
[13],  we  have  now  the  total  misalignment  angle  defined  as  C  -  *>  +  V(0  where  7  refers  to  the 
.static  misalignment  of  the  rigid  structure  while  components  of  tj(<)  define  dynamic  bending 
of  aircraft  structure.  Since  the  bending  is  due  to  the  stochastic  factors  the  time  history  of »/ 
may  be  modelled  with  the  second  order  Markov  processes,  while  7  =  0.  The  vector  of  state 
variables  i  will  consist  of  9  components,  the  first  three  being  the  static  misalignment  and 
the  other  <i  describing  the  time  dependent  flexure  angles  along  three  axes,  l  he  problem  of 
dynamic  misalignment  is  presented  graphically  in  Figure  3. 

It  is  assumed  that  each  equation  fo.  bending  angle  may  be  written  as 

»;.  +  2£,i},  +  £*»»  =  d,  (65) 

where  index  i  refers  to  a  particular  axis.  The  equation  as  such  describes  the  behaviour  of 
a  second  order  random  process  excited  by  a  white  noise  input.  Switching  to  the  system  of 
first-order  equation  the  vector  of  stale  variables  is  formed 

Xr  =  [jj.Xj . I9]r  =  [lX'lY*lZ,VX,nY<V2'VX,VY''lz]r 


(66) 
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Figure  3  Dynamic  misalignment. 


so  now  we  can  set  up  the  continuous-state  system  model 

x  =  $x  + 

or  in  the  explicit  form 


dx 
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The  observation  model  (still  linear  !)  will  be  based  on  the  following  relationship 


z  =  (,  x  i 


or  in  matrix  form 


Ao 

AS 

~ 

At’ 

0  r 
-r  0 
q  -p 


V 

0 


7.v  +  Vx 

VX 

7  V  +  r,v 

- 

VY 

.  72  +  Vz  , 

.  Vz  m 

I'sing  state-space  form  required  by  KF  we  have  for  the  measurement  model 
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The  discretisation  of  the  model  follows  from  the  relation 


j=  /9  +  $Atk 


(67) 


(68) 


(69) 


(70) 


(H) 


(72) 
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which  is  valid  provided  A tk  is  much  smaller  than  the  shortest  period  of  the  natural  modes 
of  the  continuous  system  (Gelb  [14]).  Under  this  condition  the  discretised  state  equations 
assume  the  form  defined  by  (1)  with  F  =  /o,  namely  : 

[7X  7  V'  7  2  VX  Vy  1)2  T)X  T)Y  Vz]l+i  = 

lx' 

7  Y 

O3  O3  1  7  2 

1 3  h&tk  Vx 

0  0  1-2&A  tk  0  0  1)Y  (73) 

0  -$A  tk  0  0  l-2tyAtk  0  T)z 

0  0  -&A  tk  0  0  l-2fcA*J  vx 

VY 

■Vz  J* 

+  [0  0  0  0  0  0  1?A-  tV  0z)l 

The  state  estimates  are  extrapolated  using  formula  (5)  and  are  augmented  versions  of  equa¬ 
tions  given  explicitly  for  the  case  of  a  rigid  structure.  Equations  (6)  can  be  directly  used  for 
extrapolation  of  the  covariance,  where  Qk-i  is  now  a  diagonal  matrix  with  elements  of  the 
main  diagonal  defined  as 

[o A/t_i .  uA/a._i,  nA/fc-i •  0.  0,  0,  Ali'xff'x Aik,  4i3ydyAtk,  4/i^tr^A/t,  ]  (74) 


3.2.2  Specific  force >  (accelerations)  matching  for  the  measurement  model 

The  measurement  models  of  KF  for  angular  rates  matching  may  also  be  augmented  with  the 
specific  forces,  if  the  outputs  of  accelerometers  are  available  for  processing  Schneider  denotes 
the  difference  in  specific  force  measurements  by  :a,k-  and  then  forms  the  suitable  measurement 
model  : 

A/.v]  [/a  1  [// 

-u.fc  =  A/  =  A  fy  =  fy  -  fy  (75) 

.  .  J*.  t  7 • .  k 

The  observation  model  for  accelerometers  is  based  on  the  relation  (see  Schneider  op.  cit.) 

A/  =  ;x(/  +  C’)  (76) 

wfien>  C  is  the  contribution  of  the  ( ‘oriolis  force  discussed  later.  In  more  convenient  matrix 
form  the  previous  equation  may  be  written  as  : 

A/  =  ([/)  +  (r])c  (77) 

ih  the  case  of  a  rigid  structure  and  when  the  Coriolis  force's  are  negligible,  the  above  two 
formulae  may  be  reduced  to 


A/  =  7  x  / 

A/  «  I/hr 


(76a) 

(77a) 
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where  m&>  rix  [/]  is  a  skew-symmetric  matrix  and  relations  between  the  vector  f  and  entries  of 
the  matrix  [/]  are  the  same  as  between  u  and  [w],  while  the  term  C  represents  the  correction 
due  to  the  centripetal  forces  experienced  by  the  missile’s  IMU  and  not  present  in  outputs  from 
the  aircraft.  Although  not  given  explicitly  here,  entries  of  C  are  functions  of  the  distance 
between  the  carrier  /aircraft’s  CG  point  and  the  missile’s  CG  and  the  angular  velocity  as 
sensed  by  the  INS.  It  is  assumed  here  that  the  master  INS  is  situated  ideally  at  the  aircraft’s 
CG  while  the  slave  IMU  is  located  at  the  missile’s  CG.  Giving  the  augmented  observation 
model  in  the  explicit  form  we  have 
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Since  the  same  state  variables  are  used  in  the  basic  observation  model  of  accelerometers, 
instead  of  matrix  augmentation,  two  separate  measurement  models  could  be  used  (sequen¬ 
tially)  as  originally  suggested  in  [13].  In  the  case  when  flexibility  is  taken  into  account  we 
have  the  following  measurement  equation  : 
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Again  here  we  could  consider  two  separate  observation  models  for  the  sake  of  computational 
efficiency. 


Under  certain  conditions  the  inclusion  of  additional  variables  in  the  state  model  will  not 
contribute  to  the  accuracy  of  the  alignment  process.  Before  augmenting  the  dimension  of 
the  filter  to  include  gyro  drift  rates  (either  of  the  missile  IMU  or  of  both  inertial  systems) 
analysis  of  conditions  affecting  the  process  is  necessary.  For  the  clear-cut  cases  the  conclusion 
is  (see  [1],  [It))  that  if  requirements  for  the  final  accuracy  of  alignment  are  not  too  stringent, 
the  carrier- aircraft  executes  some  manoeuvres  during  TA  resulting  in  large  angular  velocities, 
the  lime  allowed  for  TA  is  relatively  short,  and  the  drift  rates  are  low,  then  the  inclusion  of 
the  gyro  drift  rales  to  the  state  modei  is  not  appropriate  for  low-cost  AHRS. 

The  other  extreme  situation  is  when  drift  rates  are  high,  duration  of  the  alignment  process 
is  in  order  of  1  hour,  high  accuracy  of  the  alignment  is  demanded,  and  the  input  of  angular 
rates  is  relatively  low,  then  the  KF  should  include  all  equations  modelling  the  gyro  drift  rates. 
As  far  as  the  other  cases  are  concerned  detailed  simulations  of  a  number  of  models  is  needed 
before  the  "optimal"  (in  terms  of  the  speed  and  accuracy)  set  of  variable  entering  the  stale 
model  can  be  chosen 
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Further  augmentation  of  the  filter  to  include  drifts  and  biases,  as  well  as  the  detailed  al¬ 
gorithms  for  the  explicit  calculation  of  each  entry  constituting  matrices  Q  and  R  is  also 
contained  in  [13]. 


3.2.3  Low  order  algorithm  for  angular  rates  and  specific  forces  matching 

Another  algorithm  based  on  rate  matching  is  given  by  Harris  and  Wakefield  [15].  Instead 
of  considering  static  misalignment  7  and  dynamic  component  7  separately,  they  designed 
the  models  for  the  total  misalignment  angle  £,  thus  limiting  the  system  model  to  3  first- 
order  ordinary  differential  equations.  In  particular  they  considered  the  angular  rate  vectors 
in  the  "master”  and  "slave”  frames  wm,  and  determined  the  time-derivative  of  total 
misalignment  angle  : 

£=<*>,-  Tuw  (80) 

then  proceeded  with  the  approximation  of  the  direction  cosines  matrix  taking 

T(C)  =  /  +  M(0  (81) 

where  M  is  a  skew-symmetric  matrix.  The  above  formula  is  valid  only  for  small  misalignment 
angles.  Substituting  (81)  into  (80)  using  the  relationship  A/(w)(=-A/(£)w  and  noting  the 
difference  between  the  actual  and  measured  quantities  gives  the  basic  system  model  of  KF 

<  =  A/(«C  K  +  Aw*  +  At  +  An  (82) 

where  (*)  refers  to  the  measured  quantities,  A/(w*n)  coincides  with  the  previously  defined 
matrix  [w*„],  A<  denotes  the  difference  between  master  and  slave  gyro  drifts,  while  the  last 
term  refers  to  the  difference  in  gyro  quantisation  noise. 

The  above  model  is  then  implemented  in  the  KF  structure  by  treating  Aw*  as  a  known  forcing 
function  and  assuming  that  combined  differences  between  the  gyro  drifts  and  quantisation 
noise  have  Gaussian  characteristics. 


As  a  measurement  model  acceleration  and/or  angular  rate  matching  vectors  are  proposed. 
Summarising,  the  above  model  could  be  presented  in  the  form  of  a  discrete  KF  in  the  following 
way.  The  system  model  is  taken  as  : 
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The  suggested  observation  (measurement)  model  would  be  either  acceleration  (or  rather 
specific  forces)  matching  or  angular  rates  matching.  In  the  first  case  we  have 


G  A/r  0  fy  - />•  G  6t 

~i  -  A/y  -  -fy  0  fx  s’v  +  pv  (84) 

. *a .  j,  .A/,  k  t  fy  —  f X  0  .  it  .G.  *  . t 

while  for  the  second  car,e  the  discussed  observation  equation  would  be  similar  to  the  first  of 
Schneider's  model  presented  in  3.2  (except  that  the  state  vector  7  is  replaced  by  {)•  When 
specific  force  matching  is  used  for  the  above  measurement  model,  we  require  total  information 
to  be  available  from  the  master’s  and  slave’s  accelerometers  and  gyroscopic  instruments, 
which  may  be  too  rigorous  a  requirement  for  practical  implementations.  When  angular  rates 
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matching  is  used,  only  gyros  outputs  are  needed  for  the  algorithm.  For  the  former  case  the 
following  equations  form  the  KF  algorithm.  The  state  extrapolation  is  expressed  by 
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Error  covariance  matrix  is  extrapolated  via 
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The  Kalman  gain  matrix  is  now  determined  by 
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where  the  matrix  Rk  (the  last  term  in  the  bracket)  was  assumed  to  be  the  same  as  in  (62). 
Then  the  state  estimates  and  error  covariance  matrix  updates  are  given  by 
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(89) 


The  augmentation  of  the  original  set  of  equations  (S3)  follows  from  the  inclusion  of  to 
the  system  model  (as  a  part  of  the  state  variables  vector).  The  dynamics  of  A**/  is  modelled 
by 

A—1  —  -(«*'■»,)<»’  -  I'*’’*,!  C  ~  ]A.*/  4-  A Jjf  4-  A*’,.  (90) 

where  subscripts  f  and  v  refer  to  low-frequency  flexure  ami  vibratory  motions.  The  measure¬ 
ment  model  is  formed  from  the  angular  rate  matching  vector  and  is  given  in  (38]  as 

'  =:  A«*  =  A-’  4-  e  (91) 


The  above  is  a  short-cut  version  of  the  formal  measurement  model  relating  the  observed 
quantities  to  the  state  vector  (y,  A«/j.  as  in  this  case 
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Finally  we  have  a  case  when  the  system  noise  is  assumed  to  he  coloured.  The  system  model 
has  to  be  now  augmented  to  include  the  set  of  equations 

tM0-a.(0  i  =  l,2. . 6  (93) 

where  a(  t )  is  now  assumed  to  be  a  white  noise  process.  The  vector  of  state  variables  will  be 
in  this  case 

*T  =  [CT,  Au/,  i?r]  (94) 

Harris  and  Wakefield  also  give  reasons  why,  in  theory,  a  low-dimensional  filter  may  outperform 
( under  certain  circumstances)  the  augmented  version.  Firstly,  the  augmented  filter  is  based  on 
less  accurate  modelling  and  the  measurement  of  Au  via  angular  rate  matching  can  produce 
greater  uncertainty  in  the  misalignment-angle  estimate.  The  low-order  (3-state)  model  is 
based  on  the  measurements  containing  the  vibration-  and  flexural  noise  and  some  of  these 
uncertainties  (viz.  vibrations)  should  be  removed  via  direct  incorporation  of  measurements 
into  the  process  (assuming  good-quality  gyros).  Secondly,  when  the  filter  is  run  at  the 
update  rate  of  the  order  of  the  maximum  vibratory  frequency  and  additionally  assuming  that 
measurement  of  angular  velocities  u>m ,  w,  are  incoming  at  higher  rates  then  the  integration  of 
the  lower-order  model,  using  the  measured  angular  rates  u'.ay  remove  the  uncertainty  at  the 
update  times  to  a  greater  degree  than  could  be  achieved  with  the  high-dimensional  model. 

Additionally,  adaptive  estimation  of  entries  of  the  covariance  matrix  is  better  suited  for  low- 
order  models. 


Harris  and  Wakefield's  approach  is  similar  to  one  presented  earlier  by  Schultz  and  Keyes  [16] 
(and  also  to  the  results  contained  in  [IT])  in  which  acceleration  and  angular  rates  matching 
were  used  to  align  a  missile’s  strapdown  inertial  sensors  to  the  aircraft  reference  frame. 

Schultz  and  Keyes  presented  results  of  the  simulation  based  on  two  measurement  models  : 
acceleration  matching  only,  and  acceleration  combined  with  rate  matching.  Their  simulation 
results  have  shown  that  NF  with  combined  measurement  model  requires  about  3  seconds  for 
alignment  during  a  3-g  lateral  S-t.hape  manoeuvre  and  about  7  seconds  for  a  straight  and 
level  flight  with  s*  small  oscillatory  roll,  while  the  KF  using  acceleration  matching  only  has 
achieved  an  alignment  in  about  15  seconds  during  the  3-g  lateral  manoeuvre  and  does  not 
provide  sufficient  aligmueut  capability  for  any  low-g  manoeuvre  profiles. 


3,'J.I  Case  of  on  ground  alignment 

An  angular  rate  mat:  long  technique  has  been  also  used  for  on-ground  alignment  in  an  ap¬ 
proach  given  by  Kortum  (Tj.  The  problem  was  concerned  with  alignment  of  an  uncalibrated 
INS  at  rest.  The  bast,  model  is  formed  by  three  equations  being  the  linearised  kinematic  rela¬ 
tion  for  the  platform  angles.  Denoting  it--,  is  and  ii>  the  platform  angles  about  East- West. 
North-South  and  the  vertical  axes  respectively  we  have  : 


o  ii,  -fV 

7g 

P 

7.v 

i 

p 

© 

© 

7  ,v 

+ 

? 

[  0  0  J 

,7t>. 

r 

The  rates  p.q.  and  r  are  available  from  the  gyros.  Since  the  gyros  outputs  are  corrupted  by 
noise  (drifts),  the  equations  for  system  model  now  include  all  components  of  (1).  The  mea¬ 
surement  model  uses  the  fact  that  the  outputs  of  accelerontMerr  mounted  on  the  horizontal 
plane  should  be  proportional  to  misalignment  angles  7&\  7a*. 
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Since  we  are  concerned  mainly  with  in-flight  alignment,  the  detailed  discussion  of  results 
contained  in  [7]  lies  outside  the  scope  of  this  report.  However  the  method  used  for  the  order 
reduction  and  some  results  concerning  the  modelling  of  gyro  drifts  and  accelerometers  biases 
are  included  in  the  following  paragraphs. 


3.3  Modelling  of  gyro  drifts  and  accelerometer  biases. 


The  modelling  of  drifts  and  biases  of  inertia]  instruments  needs  to  take  into  account  the  type 
of  hardware  "jtd  the  environment  it  is  applied  to  (viz.  gitnbolled  and  strapdown  INS).  Since 
in  this  review  we  do  not  consider  a  particular  application  of  the  transfer  alignment  algorithms, 
the  ways  drifts  could  be  accounted  for  in  the  filter  will  consequently  vary.  We  discuss  here  a 
number  of  models,  but  the  choice  of  a  particular  one  for  implementation  depends  on  the  type  of 
hardware  used. 

The  first  of  the  presented  models  was  given  by  Baziw  and  Leondes  in  [18].  The  gyro  drifts  rate 
is  modelled  as 

<>  =  <o.  +  [f'-. •7,s..T'o>]^+ [A/,,  As..  0]ot  -f  ^*[A'^Jw  +  «7-[A"i.]ar  (9b) 

while  the  model  for  i-th  accelerometer  error  is 

Mum,  =  V,  +  [A a. .  O.V..  «r.]«r  +  «r[ A *t ]«7  (97) 

where  the  frvuwing  notation  introduced  in  the  llaziw  and  Leondes’  paper  is  used 

V  is  the  bias  of  ttir  i-th  accelerometer. 

«r  is  the  thrust  acceleration  in  the  i-th  accelerometer  (gyro)  coordinates, 

A‘u,  is  the  scale  factor  of  the  i-th  accelerometer, 

«,v,  is  the  misalignment  of  the  i-th  accelerometer’s  input  axis  in  the  plane  of  the  input  and 
normal  axes. 

<>r,  is  the  misalignment  of  the  :-th  accelerometer’s  input  axis  in  the  plane  of  the  input  and  cr«*ss 
axes. 

A...  is  the  scale  factor  of  the  i-th  gyro. 

*>«.  (*hi,  1  is  the  misalignment  of  the  i-th  gyro  input  axis  in  the  plane  defined  by  input  and  the 
spin  (output)  axes. 

A  /,  ( A  v, )  is  the  i  th  gyto  error  coefficient  due  to  mass  unbalance  along  the  input  (spin)  axis. 


(Aj  ]  is  a  symmetric  matrix  where  the  elements  on  the  main  diagonal  represent  accelerometer’s 
nonlinearity  along  the  i-th  axis, 

the  entries  of  K'jt,  are  the  cross-axes  sensitivity  of  ll.e  i-th  accelerometer  in  the  j-k  plane. 

i  A  5,  ]  is  also  a  symmetric  matrix  where  A"‘.(>  arc  the  error  coefficients  sensitive  to  the  angular 
velocity  components  for  the  i-th  gyto. 
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[A'*']  is  an  asymmetric  matrix  whose  elements  are  the  error  coefficients  sensitive  to  the  acceler¬ 
ation  components  ajak  (anisoelastic  effect)  for  the  i-th  gyro. 

Kortum  [7]  presented  a  particular  case  for  modelling  of  the  drift  of  gyroscopic  instruments  by 
interpreting  it  as  Gauss-Markov  process.  The  model  was  given  in  following  form  : 

(  =  (  +  dr+dc  + t?  (98) 

where  <  is  total  drift.  <  is  a  bias  term,  dr  is  a  random  ramp.  dc  is  a  correlated  noise,  and  i)  is, 
as  previously  defined,  a  white  noise.  In  the  form  of  state  equations  (98)  can  be  presented  as: 


i  -  0 

(99) 

dr  =  c=- 

(100) 

cr  =  0 

(101) 

r;'d‘  +  r 

(102) 

where  I'd  is  the  correlation  time  constant.  cr  is  the  slope  of  the  ramp  and  dc  is  a  white  noise. 
Tor  practical  modelling  only  the  first  three  equations  were  used  for  North  and  East  axes,  while 
the  full  set  was  used  for  the  vertical  channel.  It  was  found  that  the  basic  set  of  state-model 
equations  for  the  Kalman  filter  had  to  be  augmented  by  10  states  to  include  all  significant  terms 
describing  the  behaviour  of  gyro  drifts. 

The  accelerometers  are  modelled  in  similar  wav,  the  total  error  A«  consisting  of  the  bias  term 
V.  random  ramp  two  correlated  noise  terms  i>"  ' ,  6  -  and  a  white  noise  0.  Then*  was  a 
significant  level  of  white  noise,  since  that  term  account.  <1  for  the  instrument  error  and  for  the 
signal -transmission  error,  so  the  model  was  formally  written  as  : 

r„  =  V  tbr  +  6‘  +  +  t>  (103) 

The  model  describing  the  dynamic  behaviour  of  the  error  consists  of  .*>  first-order  differential 
equations.  Consequently,  the  state  vector  used  by  Kortum  in  his  system  model  for  misalignment 
icf.  formula  (95))  was  augmented  to  33  components.  Kortum  discusses  also  the  problem  of 
order  reduction  following  the  analysis  of  covariance  of  the  full  order  model.  The  model  reduction 
follows  the  elimination  of  the  states  (and  their  dynamic  equations)  which  do  not  influence  the 
behaviour  of  the  system  in  a  significant  way,  and  those  which  are  not  observable.  The  resulting 
reduced  order  models  are  discussed  in  more  detail  in  3.5. 

In  the  case  nf  the  amplest  modelling  ( cf  [13})  gyro  drift*  can  be  represented  by  a  constant,  so 
the  corresponding  model  is 

(104) 

Another  option  i  •  to  represent  them  either  by  a  random  walk  in  which  case 

«i.  -  Vfo.gj  (105) 

or  hv  first  order  Markov  processes,  so 

^  ;J,c  +  d,  ( 106) 

where  ,1,  are  suitably  chosen  coefficients. 
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The  accelerometer  biases  V  may  also  be  modelled  by  any  of  the  equations  (104)-(10(>).  If  the 
initial  assumption  on  the  aircraft’s  INS  is  to  be  kept  (i.c.  the  information  supplied  from  aircraft 
via  interface  is  not  corrupted  by  any  error)  then  the  models  discussed  in  3.2.  and  3.3  can  be 
further  augmented  by  inclusion  of  3  states  describing  the  behaviour  of  strapdown  gyro  drifts  and 
3  states  modelling  accelerometer  biases.  If  the  assumption  is  removed,  then  we  have  to  augment 
the  models  by  6  and  12  states  respectively.  Table  1  summarises  the  modelling  assumptions  and 
resulting  dimensions  of  state  models  for  the  linear  Kalman  filtering  applied  to  the  TA  using 
angular  rate  matching  techniques. 


Dimensions  of  KF  (state  models) 
for  angular  rate  matching 


Schneider’s  model 

Harris- Wakefield  model 

Rigid  structure* 

3 

- 

Flexible  structure 

9 

3 

(  +  )  Gyro  drifts  on  missile 

12 

b 

i  4- )  Drifts  ou  INS  (aircraft )  gyros 

15 

9 

(  +  )  A.  eleromoters  biases 

is- 21 

12-15 

Table  1.  Dimensions  of  KF  -  comparison  of  algorithms. 

Inclusion  of  bias  terms  into  the  state  vectors  has  an  obvious  result  in  the  increased  dimensions  o; 
th“  state  matrices,  which  mtitribute  to  computational  problems  (matrix  ( // 1 ( 4» t _  s  f**_, 

VQk  _tl  !  ♦  /i,.! ~ 1 .  v. inch  is  part  of  an  explicit  expression  for  the  Kalman  gain,  must  be  found 
for  each  step  of  the  procedure}.  An  interesting  example  of  incorporation  of  bias  estimation  into 
the  KF  was  given  by  ignani  [I9j.  Two  separate,  decoupled  Kalman  filters  were  designed,  one  for 
each  set  of  states  (one  *««i  describes  a  linearised  kinematic  or  dynamic  model,  white  the  other 
dents  with  slowly  changing  biases}.  It  is  assumed  here  that  biases  states,  although  not  strictly 
constant,  will  undergo  only  limited  variation  in  time. 

The  model  under  consider  at  tot.  is.  designed  using  the  following  assumptions  : 

th<-  A  *  I  state  vector  !*\  is  formed  from  A'j  and  A;  dimensional  vectors  a’',  jr1  t  A,  r  A,  s  .V  ) 
such  that  [/.  s  [jr:.  jr;! 

?■?'’»  and  represent  the  dynamic  state*  (angular  rates,  bending  angles,  total  misalign 
merit  angle*  etc.  depending  on  the  choice  of  technique)  and  the  bias  states  (gyro  and/or 
accelerometer l  respectively,  at  the  k  th  update  point. 

system  and  observation  noise  parameter*  satisfy  the  usual  assumption  of  linear  KF  (see  chap:. 
I),  with  known  power  spectra!  densities. 

*  MrtU*  of  the  dynamic  states  and  blast's  are  correlated;  this  dependency  is  expressed  in  the  form 

a  zl  +  ,4/0r?  ( 107) 

where  the  star  refer*  to  those'  states  which  are  not  correlated  with  the  bias  and  A/»  is  a  known 
matrix 
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-  the  initial  error  covariance  relationships  are 

PXQ  =  P;o  +  M0Px,Mj  (108) 

Pxxl=M0Pxl  (109) 

where  PXo ,  PXo,  Px 2  are  the  covariance  matrices  of  initial  estimation  errors  of  z0,  xa  and  Xq. 

Thus  the  model  of  Ignani  [19]  may  be  presented  (using  somewhat  different  notations)  in  the 
following  way.  The  system  model  is 


xl  =  (110) 

**  =  *Li+^2  (ul) 

while  the  measurement  model  at  the  n-th  update  point  is 

zk  =  Lkx\  +  Ckx\  +  q  (112) 


The  Kalman  filter  matrices  may  now  be  presented  in  the  following  way 
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while  the  gains  matrix  will  be  partitioned  in  the  form  Ii  =  [A'1,  A'2]1 .  Using  these  relationships 
we  have 
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(114) 

(115) 
(110) 
(117) 


The  block  structure  of  system,  observation  and  variance  matrices  leads  to  the  design  of  two 
independent  estimators  for  the  dynamics  states  and  biases  vector.  The  formulae  are  given 
explicitly  in  [19]. 


3.4  Velocity  and  position  matching. 

A  separate  set  of  methods  are  those  relying  on  velocity  information  and  not  directly  utilising 
information  on  angular  rate1-  (in  a  sense  that  the  difference  of  the  rates  enters  neither  the  system 
nor  observation  vector,  but  it  may  be  used  as  an  entry  in  the  system  or  observation  matrix). 
If  the  above  condition  is  not  fulfilled  and  differences  in  velocities  as  well  as  the  differences  of 
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angular  rates  enter  the  system  and/or  observation  vector,  we  shall  refer  to  the  resulting  models 
as  augmented,  or  "combined”. 

Velocity  and  position  matching  methods  for  transfer  alignment  have  been  discussed  in  numerous 
publications  -  for  more  details  see  -  [l]-[4],  [8],  [l8]-(26].  Only  standard  approaches  and  models 
will  be  discussed  in  detail. 

Farrell  in  [26]  proposed  an  algorithm  for  TA  based  on  the  9-dimensional  system  model  with 
st ate- variables  vector  formed  from  velocity  error,  misalignment  angle  and  drift  components  in 
the  from  x  =  [An,  7,  e].  Physical  relations  leading  to  the  model  stem  from  an  the  extension  of 
discussion  given  in  previous  paragraphs.  For  the  system  model  we  have 


AV  =  C  X  /  +  'da 

(118) 

C  =  f  +  K 

(119) 

c  =  -1  /r<  +  tic 

(120) 

while  the  observation  model  may  be  written  as 
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The  complete  transfer  alignment  algorithm  with  flexibility  taken  into  account  is  based  on  15 
states  vector  for  the  system  model  (9  states  from  the  last  model  plus  (i  first  order  equations 
modelling  the  flexibility,  cf.  earlier  approach  by  Schneider  -  described  in  3.2).  A  simulation 
block  diagram  for  the  proposed  algorithm  is  presented  in  Figure  4. 

Bar  Ithzack  [25]  developed  a  full  9-state  filter  with  the  state  vector  consisting  of  3  position  errors, 
corresponding  North.  Fast  and  down  velocity  errors  components  and  the  misalignment  errors. 
He  then  analysed  the  possible  order  reduction  by  experimenting  with  7-  and  5-state  filters,  then 
further  reducing  the  order  with  a  set  of  3-.  and  2-state  time-sharing  filters.  Some  of  these  results 
are  discussed  in  the  next  paragraph. 

The  vector  of  states  of  Bar-Itzliack’s  9-state  model  can  be  written  as  : 

x  =  fr.v.  rt  ,  rp .  A«\\.  Art  .  Arp ,  ■) v .  *■*,.  o/,]7  (122) 

so  the  (continuous,  state-space  system  model  may  be  represented  by  the  equation 

x  -  4-  it  ( 123) 

where  the  matrix  <*>  is  defined  in  the  following  way 
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Figure  4  Simulation  Block  Diagram  for  TA 
Source  :  Farrell  [26] 
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while  the  noise  vector  is 
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The  ’’truth  model”  used  in  [25]  for  the  comparison  of  the  simulation  results  includes  24  states, 
and  the  performance  of  the  designed  filters  was  analysed  using  a  true  covariance  simulation 
program  (including  the  states  of  ’’truth  model’’  and  the  differences  between  the  values  of  the 
states  produced  by  the  filters  and  the  corresponding  values  obtained  from  the  "truth  model”). 

Sutherland  [27]  investigated  the  applications  of  KF  for  transfer  alignment  using  the  optimal 
control  techniques  to  determine  manoeuvres  which  minimise  filter  errors.  He  gives  the  following 
five-state  system  model 

'  [0  0  0 

j  Auy  0  0  -g 

~n  Cx  =  o  J?-1  o 

dt  <y  -7T1  0  — u>, 

l  C.  J  to  uy 

with  observation  model  defined  as 
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The  presence  of  acceleration  terms  in  the  system  matrix  was  instrumental  in  determining  op¬ 
timal  manoeuvres  for  the  alignment.  Additional  assumptions,  which  made  the  application  of  a 
linear  optimal  control  technique  possible,  were  :  constant  speed,  chosen  maximal  value  for  the 
terms  of  horizontal  acceleration  and  known  initial  mis  misalignment  errors  and  other  stochastic 
parameters.  The  control  parameter  was  chosen  to  be  the  heading  rate  of  change,  while  the  per¬ 
formance  index  minimised  the  mean  square  of  errors  of  the  misalignment  angles  at  a  specified 
final  time.  The  found  solution  (as  can  be  expected  with  linear  control  problems  and  the  bounds 
on  control  parameters  specified)  indicated  the  necessity  of  applying  the  switching  control  with 
maximal  rate  of  change  of  heading  angle  (bang-bang  solution). 

Bryson  in  [x]  designed  the  following  5-state  model  (horizontal  components  of  velocity  vector  and 
misalignment  angle)  used  for  the  description  of  errors  of  an  INS  with  locaJ  level.  North-pointing 
platform  : 
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The  model  was  used  to  derive  a  simple  formula  for  identification  of  misalignment  as  a  function 
of  the  flight  profile.  For  the  straight  and  level  flight  the  "fast  observer”  for  East- West  tilt  was 
expressed  as 
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while  for  the  heading  error  the  equations  for  fast  observer  are 
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Bryson  and  Powell  derived  also  the  fast  observers  for  misalignment  during  manoeuvring  flight 
(constant-altitude,  constant  heading  deceleration-acceleration  and  constant  bank  angle  turn). 
Details  are  contained  in  [8j. 


Baziw  and  Leondes  in  [18]  presented  a  number  of  different  designs  for  the  Kalman  filter  based 
on  velocity  and  position  errors  (being  first  and  second  integrals  of  the  accelerometer  outputs)  for 
the  observation  model.  It  initially  includes  the  errors  due  to  scale  factor,  biases  and  a  correlated 
noise  modelled  by  Markov  processes,  although  it  may  be  reduced  to  just  position  and  velocity 
errors  (+  white  noise). 

The  state  vectors  (for  a  number  of  the  system  models  presented)  include  some  of  the  following 
variables  :  positions  and  velocities,  random  vibrations  modelled  by  second  order  Markov  pro¬ 
cesses,  coloured  noise,  misalignments,  biases,  drifts,  master  INS  error  parameters,  observation 
error  parameters,  and  the  error  vectors  of  the  nominal  positions  of  the  master  and  slave  guid¬ 
ance  instruments.  The  dimension  of  the  state  vectors  varies  from  6  to  51,  the  preferred  option 
consisting  of  36  variables.  Baziw  and  Leondes  also  discussed  the  possibility  of  including  the 
angular  velocity  observations  into  the  model. 


Yamamoto  and  Brown  [2]  described  an  algorithm  for  alignment  of  an  inertiaily  guided  air-to- 
surface  strategic  missile  based  on  position  matching  (latitude,  longitude)  for  the  measurement 
model  and  a  10-state  system  model.  The  state  vector  includes  two  position  errors,  horizontal 
velocity  errors,  three  misalignment  angles  and  three  states  of  gyro  drifts,  so  using  our  notation 
x-  (*\v.  ry.  A.'\v.  At y.  7/v,  7k-  7 p.  «.v.  «&•,  (i)}1 .  the  measurement  model  can  be  written 
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The  proposed  filter  was  examined  during  a  complex  simulation  analysis.  Captive  flight  of  missiles 
has  been  simulated,  together  with  a  separate  assessment  of  the  Kalman  filter  for  the  carrier  and 
for  the*  missile.  Since  the  lower  limit  of  the  missile’s  alignment  error  depends  on  the  accuracy  of 
the  data  supplied  from  the  carrier’s  INS,  prior  to  the  data  transfer  the  carrier's  inertial  navigator 
is  aligned  (from  cold-start  conditions)  combining  the  data  from  the  doppler  radar  and  position 
fix  radar.  The  simulation  process  described  in  [2]  is  presented  in  Figure  5. 


Kain  and  Cloutier  [28]  presented  an  analysis  of  24  state,  6  measurement  Kalman  filter  imple- 
mentable  on  25  mHz  M68020  microprocessor  with  M68882  coprocessor.  Using  this  particular 


Figure  5  Simulation  of  TA  for  SRAM  missile 
Source  :  Yamamoto  and  Brown  [2]. 

harware  configuration  the  propagation  and  update  cycle  time  of  28  milliseconds  was  achieved. 
The  states  include  velocity  erros,  angular  differences,  physical  alignment  errors,  accelerometer 
and  gyro  biases  and  scale  factor  errors,  and  gyro  g-sensitive  drifts.  The  Monte  Carlo  simulation 
was  performed  for  the  truth-model  consisting  of  42  states  (24  states  for  the  filter  and  6  third 
order  Markov  processes  for  the  wing  flexure  modelling).  The  misalignment  error  was  less  than 
1  mrad  per  axis  and  the  convergence  time  less  than  10  seconds. 


3.5  Reduced  order  filters. 


The  models  derived  by  Bar-Itzhack  (cf.  [25])  have  been  used  for  in-flight  alignment  (five  states 
model)  and  transfer  alignment  (seven  states  model),  the  latter  including  information  on  position 
error.  The  filter  based  on  reduced  order  models  is  designed  for  relatively  fast  (approximately 
3  minutes)  alignment  of  aircraft'  INS.  The  first  two  second-order  filters  (presented  later  as  A 
and  B,  see  equations  (133)-(136))  describe  velocity  error  in  straight  and  level  flight.  The  third 
order  filter  C  modelled  by  equation  (137)  describes  the  behaviour  of  velocity  error  during  the 
horizontal  (S-shaped)  manoeuvre.  The  reduced  order  filters  operate  in  time-sharing  mode  thus 
saving  computational  effort. 

The  filters  operate  in  sequence  and  their  operation  has  been  synchronised  with  the  flight  profile. 
During  about  30  seconds  of  straight  and  level  flight  filters  A  and  B  operate  in  an  alternate 
way.  with  no  filter  being  "frozen”.  When  one  of  the  two  filters  does  propagation  and  update 
i.e  full  KF  operates  (equations  (l)-{9)),  the  state  vector  of  the  other  is  just  being  propagated 
(equation  (5)),  which  only  requires  a  knowledge  of  entries  of  the  state  matrix  and  the  state 
vector  calculated  in  the  preceding  time  interval.  After  that  period  the  estimated  value  of  North 
and  Fast  misalignment  angles  are  removed  from  the  output  of  inertial  sensors  (which  is  referred 
to  as  resetting  control)  and  the  third  order  filter  C  estimates  7 $.  This  part  of  the  alignment 
wa*s  performed  in  about  3  minutes  (simulation  results  quoted  by  Bar-ltzhack  show  convergence 
for  a  lateral  S-shaped  manoeuvre  lasting  about  210  seconds). 
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The  five  state  model  chosen  in  [25]  for  in-flight  alignment  is 
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(132) 


The  seven-state  model  for  transfer  alignment  includes  two  horizontal  position  errors  ( r s  and 
rE).  Time  sharing  reduced-order  filters  were  designed  in  the  following  way  : 
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[11]  also  gives  the  following  simplified  models  : 
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The  results  of  the  simulation  studies  quoted  in  [25]  confirm  the  adequacy  of  simplified  filters 
(their  performance  degraded  by  less  than  2%  than  filters  with  no  approximation  introduced  in 
the  state  matrices). 


Kortum  [7]  investigated  possible  reductions  in  the  order  of  the  Kalman  filter  using  covariance 
analysis.  The  results  from  the  simulation  of  the  full-size  15-states  model  were  compared  with 
lower  order  models  (ranging  from  3  states  to  7).  The  following  conclusions  were  reached.  When 
the  7-order  filter  provided  the  bounds  for  accuracy,  reduction  of  the  order  to  4  states  did  not 
influence  the  accuracy  of  estimates  of  the  remaining  states  in  the  short  period  of  time.  For  the 
time  interval  of  10  minutes  the  only  noticeable  effect  concerns  the  influence  of  gyro  drift  about 
the  North-South  axis  and  its  influence  on  7/^.  Reduction  of  the  order  to  3  states  only  was  not 
recommended  (the  accuracy  of  the  estimate  of  7^  was  appreciably  affected  without  the  inclusion 
of  the  estimate  of  the  corresponding  drift  rate). 


Note  that  all  the  methods  of  this  section  require  knowledge  of  velocity  and/or  position.  Thus, 
although  they  may  be  superior  to  angular  rate  matching  methods,  they  are  not  applicable  to 
attitude  and  heading  reference  systems  which  do  not  compute  the  full  navigation  solution. 
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4.  CONVERGENCE  OP  FILTERS  AND  COMPUTATIONAL  REQUIREMENTS 


Divergence  of  the  Kalman  filter  produces  growing  estimate  errors,  which  are  larger  than  theoreti¬ 
cally  predicted.  It  is  generally  caused  by  mismatched  or  uncontrollable  ("undisturbable”)  system 
models.  Controllability/observability  conditions  should  be  applied  to  the  derived  models  before 
proceeding  with  the  simulation.  Among  the  methods  for  preventing  divergence  are  pole  shifting, 
eigenvalue  constraints  and  added  noise  (see  [5]  and  [29]  for  details).  Another  problem  arises  in 
an  efficient  implementation  of  a  particular  form  of  Kalman  filter  (viz.  usage  of  Joseph  form  for 
covariance  matrix  and  square  root  filtering  in  order  to  maintain  properties  of  the  covariance  matrix). 

Mendel  [30]  analysed  the  computational  problems  associated  with  the  implementation  of  code  for 
KF  algorithm.  The  following  table  summarises  the  requirement  in  terms  of  number  of  multipli¬ 
cations  and  additions  needed  for  KF  where  A  is  the  dimension  of  the  state  vector  of  the  system 
model,  while  M  is  the  dimension  of  the  state  vector  of  the  measurement  model. 


Variable  Additions 

State  variables  extrapolation  A 2 

Covariance  matrix  extrapolation  4  A3  -  3 A2 
Kalman  gain  NM(2M  + 

State  update  2M  N 

Covariance  update  Af3  -f  A2(A 


Multiplications 

A2  +  A 
4A3 

f-2)+M3  Af(Af2  +  A2  +  2MN) 

2MN 

-1)  A3  +  N2M 


Table  2.  Computational  requirement  of  KF. 

Source  :  Mendel  [30]. 

Assuming  that  5  £/sec  is  an  upper  limit  for  addition  or  multiplication  Table  3  compares  the  execution 
times  for  some  of  the  presented  methods  for  transfer  alignment. 


Method 


N  M  Time  (l  cycle)  in  milliseconds 


Rate  matching  : 

Schneider  A 

3 

3 

3 

Schneider  B 

9 

3 

40 

Rate  and  acceleration  matching  : 
Schneider  B 

9 

0 

50 

Harris- Wakefield 

3 

3 

3 

Velocity  matching  : 

Farrell 

9 

3 

40 

Bar-Itzhack 

7 

3 

20 

Bar- It /.hark 

3 

2 

2 

Bar-Itzhack 

2 

l 

0.5 

Position  matching  : 

Yamamoto- Brown 

10 

2 

50 

Table  3.  Time  requirement  for  TA  computation 


The  above  numbers  should  bo  treated  as  an  approximation  of  the  upper  limit  of  the  time  needed 
for  one  cycle  of  calculations  assuming  that  both  additions  and  multiplications  take  5  psec.  The 
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time  needed  for  calculations  may  be  further  reduced  if  the  philosophy  of  the  design  follows  some 
general  rules.  These  include  (cf.  [5]  for  details)  : 

(1)  Reduction  of  the  state  dimensions  while  maintaining  the  basic  characteristics  of  the  system. 

(2)  Simplification  (i.e.  linearisation)  of  the  model  by  neglecting  (or  replacing  by  the  linear  term  of 
an  expansion)  the  nonlinear  terms,  couplings  etc. 

(3)  Using  the  symmetry  of  matrices,  sparsity,  and  block-decomposition  method. 

(4)  Using  precompute  values,  known  approximations  and  prefiltering  (viz.  compression  of  data)  to 
make  sample  periods  longer. 

(5)  Implementation  of  a  "square  root  filter”  as  a  way  to  remove  the  double  precision  requirement. 

(6)  Approximation  of  stored  constants  as  powers  so  multiplications  are  replaced  by  shift  operations. 

(7)  Efficient  programming  practices. 

The  order  of  the  Kalman  filter  should  be  considered  in  view  of  the  time  allowed  for  the  alignment 
process.  The  shorter  the  time  allowed  for  the  process  the  fewer  the  number  of  variables  to  be 
included  in  the  state  vectors  of  the  system/measurement  models. 

Systematic  design  procedure  of  a  Kalman  filter  for  the  transfer  alignment  problem  should  consists 
of  a  number  of  steps  (cf.  [5]  for  a  general  case)  : 

(1)  Development  of  a  mathematical  model  for  the  transfer  alignment.  At  this  stage  it  may  be 
necessary  to  include  the  models  of  both  inertial  guidance  instruments  (master  and  slave  INSs)  and 
possibly  an  interface  if  it  is  known  to  contribute  to  time  lags.  Flight  simulation  (6D0F)  using  the 
complete  model  usually  follows  and  is  validated  with  experimental  data.  Error  analysis  then  leads 
to  any  necessary  changes  in  the  models. 

(2)  Generation  of  full  order  Kalman  filter  followed  by  a  covariance  analysis. 

(3)  Reduction  of  order  by  removing  some  of  the  variables  especially  cross-coupled  terms,  employing 
approximations,  possibly  deleting  uncoupled  noncontributing  equations.  It  may  lead  to  a  number 
of  models.  Design  a  proper  KF  should  include  an  analysis  of  each  model. 

(1)  Covariance  performance  analysis  for  each  reduced  order  filter.  Each  of  the  models  is  to  be  fine 
tuned",  which  in  particular  includes  the  choice  of  initial  values  of  variance  of  covariance  matrices. 


(a)  Monte  Carlo  simulation  and  analysis  of  the  best  designs  from  the  previous  step. 

(fi)  Selection  of  the  design  based  on  analysis  of  the  performance  versus  computing  efficiency  (real¬ 
time  requirements). 

(7)  Implementation  and  operational  tests. 
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5.  CONCLUSIONS 

Presented  methods  differ  with  respect  to  computer  memory  required,  conditions  for  convergence 
and  consequently  the  time  of  alignment  process.  Combined  rate  and  acceleration  matching  achieved 
convergence  in  less  than  10  seconds  (during  the  lateral  manoeuvre),  while  the  rate  matching  alone 
required  the  time  of  order  of  1  minute.  Velocity  matching  methods  (see  3.6-3. 7)  required  3-5  minutes 
(with  the  exception  of  the  method  reported  in  [26]),  while  position  matching  algorithms  developed 
for  aided  INS  (cf.  [64])  needed  20  minutes  to  attain  a  steady-state.  However,  these  numbers  should 
only  serve  as  a  very  general  indication,  since  the  conditions  of  experiments  varied.  Another  factor 
is  the  computational  time  required  per  cycle  of  Kalman  filter  algorithm,  which  depends  on  the 
number  of  system  and  observation  variables.  Given  the  same  hardware  configuration  it  ranges 
from  0.5  milliseconds  -  in  case  of  2  system  variables  and  1  observation  variable  needed  in  one 
velocity  matching  method  -  to  50  milliseconds  in  case  of  10  system  variables  and  2  observation 
variables  (position  matching  method). 
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